This filter is a combination of adaptive ud decomposition kalman filter with quad method . it use quad method to detect and correct the gross errors in observations , use ud decomposition technique to improve computation precision and overcome the instability of filter caused by instability of values , when divergence of kalman filter had been detected , an adaptive filter is employed to adjust the prediction error covariance matrix 該法用擬準(zhǔn)檢定法準(zhǔn)確地探測(cè)和修正量測(cè)方程中存在的粗差;用ud分解算法改進(jìn)了計(jì)算精度,克服了由于數(shù)值不穩(wěn)定帶來濾波的不穩(wěn)定性;當(dāng)判斷濾波器發(fā)散后,則啟用sage自適應(yīng)濾波器,調(diào)整預(yù)測(cè)誤差方差,以克服濾波器的發(fā)散。